Qualitative study of a robot arm as a hamiltonian system 
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Abstract 

A double pendulum subject to external torques is used as a model to study the stability of a 
planar manipulator with two links and two rotational driven joints. The hamiltonian equations of 
motion and the fixed points (stationary solutions) in phase space are determined. Under suitable 
conditions, the presence of constant torques does not change the number of fixed points, and 
preserves the topology of orbits in their linear neighborhoods; two equivalent invariant manifolds 
are observed, each corresponding to a saddle-center fixed point. 
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I. INTRODUCTION 



The problem of the stability of motion and equilibrium of manipulators is essential to 
their applicability in industry. In this work, we analyze the stability of one class of such 
manipulators, namely, planar manipulators with two links and two rotational driven joints 
(see Fig.|l]), modelled by a double pendulum subject to two constant external torques 7\ and 
T 2 (see Fig.0). Each pendulum has lenght L and has a particle of mass m attached to its 
end. 



FIG. 1: Simplified diagram of a planar manipulator with two links. 

For any given configuration (61,62) where < 61 < 2tt and < 6\ < 2ir, and conjugate 
momenta pi = p 2 = 0, the torques 7\ and T 2 can be adjusted so that this configuration 
become stationary. In this work we will study the dynamics of this system in the linear 
neighborhod of stationary configurations under constant external torques. 

As indicated in Fig.0, the model consists of a combination of two simple pendula with 
equal length L, where the two drivers are represented by external torques T\ and T 2 applied 
at points A and B, respectively. For the sake of simplicity, we shall consider the mass m of 
the object held by the end-effector C as being equal to the mass of the driver in B. 

We apply qualitative analysis techniques JT], 0, ^ suitable to non-linear systems, using the 



2 



FIG. 2: Double pendulum model for the planar manipulator in Fig]T[ The pendulum is subject to 
the external torques Tl and T2 at points A and B, respectively. 

hamiltonian formalism. 



II. DYNAMICS OF THE MODEL 



The system depicted in Fig.|2] can be represented by the following hamiltonian function 
with two degrees of freedom: 

-mgL (cos(^) + 2cos(# 2 )) - 9 1 T 1 (t) - 9 2 T 2 (t), (1) 

where g is the acceleration of gravity and (pi,P2) are the conjugate momenta to the angular 
variables {9i,9 2 ), respectively. The functions 7i(t) and T 2 (t) stand for arbitrary external 
torques on the system. The hamiltonian equations of motion yield the non-integrable, non- 
linear dynamical system 
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We will search for fixed points in phase space. At first, we will let T\ = T 2 = and discuss 
the case of null external torques; afterwards, we shall treat the case of non-null constant 
external torques. 



III. THE ROBOT ARM WITH NULL EXTERNAL TORQUES 

Hamilton equations (0) and (H) have four fixed points. Namely, 
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where the matrix lines are ordered from top to bottom according to the coordinates 
(0i, Pi, 9 2 ,p 2 ), respectively. The total energies associated to each fixed point are 

Ei = —3mgL , E 2 = —mgL , E 3 = +mgL , E± = +3mgL. (7) 

Upon linearization of the system of Hamilton equations, we obtain 

Xi = J{Xi, (8) 

where % = 1,2,3,4 labels the fixed points. The vector Xj has the general form = 
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h,Pi,@2,P2), and the jacobian matrices Ji are 
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The general solution to the linearized system (||) around a fixed point is a superposition of 
four independent solutions, 

m = E $^'4?, (13) 



m=l 



where A$ are the eigenvectors associated to the eigenvalues A^ of Jj, and the coefficients c$ 
are integration constants that depend on the initial conditions. The eigenvalues associated 
to the Ji matrices are, respectively, 



J x : A$ = ±iwo V2 - v 7 ^ and A$ = ±iu ^2 + v 7 ^ ; 



(i) 



(14) 



^2 : A^ = ic^ov^ and A3 2 ] = ±i cuov 7 ^ 



(15) 



■^3 : ^i 3 2 = ±^0^2 and A3 3 ] = ±z c^ov^ 



(3) 



(16) 



5 



J 4 ; \W = ±uj \/2- V2 and Ag 4 ] = ±uo Q \j 2 + ^2 . 



(17) 



where too — y9/L is the natural oscillation frequency of as simple pendulum for small 
amplitudes. In view of eqs.([L4]) to (|iT|), we may classify^], |8| the four existing fixed points: 
V\ is a pure center; V% and V3 are saddle-centers and V4 is a pure saddle. 

A. The invariant manifolds: case of null torques 

An important characteristic of this system when the torques are null is the presence of 
two similar invariant manifolds, each one of them associated to a saddle-center fixed point. 
Those manifolds are 



In view of the resemblance of the two invariant manifolds, our discussion will focus on 
Aii, but can be straighforwardly extended to Ai2- The phase portrait upon Aii is shown in 
FigfJ. The resulting phase portrait is equivalent to that of a mathematical pendulum with 
arbitrary amplitude of oscillation. 
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FIG. 3: Phase portrait on the invariant manifold Aii- 

Dynamics upon Aii is governed by the two-dimensional system of equations 
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In FigfJ each orbit has a definite total energy. The point I corresponds to the solution 
(#i = 0,pi — 0), a pure center upon the invariant manifold. That indicates that the robot 
arms is standing still in the vertical position. Another saddle-center fixed point upon M.\ is 



BC link is free to move. 

B. The normal form of the Hamiltonian 

The hamiltonian describing the dynamics in the linear neighborhood of a saddle-center 
can always be rewritten as the sum of a rotational energy term and a hyperbolic energy term. 
This is a consequence of Moser's theorem ||, which establishes that in a sufficiently small 
neighborhood of any saddle-center point, there is a set of canonically conjugate variables 
so that the hamiltonian in that neighboorhood is separable into a purely rotational term, 
and a purely hyperbolic term. We will apply the method of normal forms to find this set of 
coordinates. 

The method of normal forms consists basically in applying Taylor series expansion to 
the velocity field around a fixed point. When such point is a saddle-center point, we may 
write the expanded hamiltonian in its quadratic (or normal) form. A canonical transforma- 
tion is carried out so that we have vanishing off-diagonal terms 0. The transformation for 
the linear neighborhood of V2 is 



(#i = 7T,pi — 0). They correspond to the case where the AB link of the robot arm (cf.FigsJI] 
and H) remains in the vertical position (downwards and upwards, respectively) , and only the 
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In the new coordinates (x, p x , y, p y ), this fixed point is described by 



V 2 : (x = 0,p x = 0,y = 0,p y = 0). 



(25) 



Substituting fl2"I|)-(p3D into the hamiltonian (|XJ) and linearizing it in the neighborhood of V2, 
it can be finally cast in its normal form 



H — E hyp + E rot + e, 



(26) 



where 



e = mgL (27) 
fixates the energy surface upon which the motion of the robot arm will take place. The 
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correspond to the hyperbolic and rotational energies, respectively. The a[s are numerical 
positive coefficients originated from the canonical tranformation fl2l|) . Those coefficients 
can be found in appendix B. In the new coordinates, according to the hamiltonian (^6|), the 
linearized solutions around P 2 are 



J 2(3+v / 17)s£(5+v / 17) 
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p y {t) = D 2 cos (wt + a) 

Notice that in this linear neighborhood the rotational and hyperbolic motions are totally 
uncoupled. In @Sf) i ci, c 2 , -D 2 and a are arbitray constants of integration, depending on the 
initial conditions. The frequency w is related to the frequency wq by 
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Similar results are found for the remaining saddle-center fixed point V3, and we shall omit 
such discussion here. As to the pure center fixed point, it will be described in the new 



coordinates as V, : * = -M5 + V17) 2.(5 + Vl7) = Q 

17 + 5^ y 17 + 5^ y 



The linearized solutions in the neighborhood of the pure center are 
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2 2 
are also related to the frequencies wo. 

As to the dynamics in the neighborhood of the pure-saddle fixed point P4, the solutions 
are linear combinations of real exponential functions. We shall restrict our discussion to the 
saddle-center fixed points, due to it rich topology. 



C. Topology of the linear neighborhood of saddle-center 

Let us now analyze all possible motions in the linear neighborhood of the saddle-center 
point. As we have seen, dynamics in this neighborhood is governed by the hamiltonian (p6|). 
Thus, there are three possibilities: (a) E rot 7^ 0; Eh yp = 0; (b) E rot = 0; Eh yp 7^ and (c) 
E ro t 7^ 0; E hyp 7^ 0. We will discuss each case separately, 
(a) For E rot 7^ 0, E hip = 0, there are two possibilities: 
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1. If (p x = 0, x = 0), we have unstable periodic orbits r upon the (y, p y ) plane, and their 
projection upon the (x, p x ) plane is the (x = 0, p x = 0) point. Such orbits depend 
continuously on the parameter e, so that 

E rot = -mgL. (32) 



2. If p x = ±mL^p^j-x, the onedimensional linear manifolds Vg (stable) and V^(unstable) 
(cf. Fig.f| and Fig.[|) tangent the saddle-center are defined. The separatrices S are non- 
linear extensions of Vs and Vi. The general motion is the direct product of periodic 
orbits t with the manifolds Vs and Vi, generating the structures of cylinders (r x 
Vs) (stable) and (r x Vi) (unstable). Orbits on such cylinders have the periodic orbits r 
as their assymptotic limit (t — > oo). Notice that those cylinders have the same energy 
as that of the unstable periodic orbits r. 



FIG. 4: Projection of orbits upon the (y,P y ) plane near y = 0, corresponding to unstable periodic 
orbits in the neighborhood of the fixed point. 
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FIG. 5: Projection of orbits upon the (x,P x ) plane near x = 0, revealing the hyperbolic structure 
in the neighborhood of the fixed point. 

(b) If E rot = and Eu v ^ 0, the motion is upon the invariant manifold M. denned by flUf ) 
or (U). 

The resulting motion of the system consists in hyperbolic orbits on the (x, p x ) plane, as the 
projection of orbits on the (y, p y ) plane is reduced to a single point denned by (??). 

(c) If E rot ^ and E hip ^ 0, the resultant motion is the direct product of hyperbolae related 
to the I, I', II and II' regions of Fig.^, with the periodic orbits on the (y, p y ) plane in the 
linear neigborhood of the saddle-center fixed point. 
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IV. THE ROBOT ARM WITH CONSTANT EXTERNAL TORQUES 



We will analyze now the case of non-null constant external torques. There are still four 
fixed points, namely, 
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where f3\ and /3 2 stand for the constant external torques. Coordinates, from top to bottom, 
are ordered according to (^1,^1,^2,^2)- The coordinates of those fixed points must be real; 
hence, their existence is subject to the two simultaneous conditions: 



I A I < 2mgL, 
\/3 2 \ < mgL. 



(35) 
(36) 



If those conditions are satisfied, there will be four fixed points, as in the null-torque case. The 
same procedure used previously to analyze the nature of such fixed points can be applied, 
and their nature determined. It turns out that for 



< 2mgL 
\P 2 \ < mgL, 



(37) 
(38) 



The nature of fixed points is the same for that in which the torques are null. In other 
words, V[ is a pure center, with corresponding energy 
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In their turn, V' 2 and V 3 are saddle-center points, with corresponding energy 



E 2 = -\/-f3l + m 2 g 2 L 2 + ,J-/3 2 + Am 2 g 2 L 2 + 
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respectively. The fourth fixed point is a pure saddle, with energy 



E 4 = yj-pl + m 2 g 2 L 2 + ^/-/3 2 + 4m 2 ^ 2 L 2 + 

arctan ( I A — arctan ( ^ 2 I /3 2 . (42) 
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If /3i = /3 2 = 0, we fall into the null torques case, and the classification of those points is the 
same. In the special case 

| /3a | = mgL and = 2m^L (43) 

it can be shown that all fixed points are degenerate, i.e., the jacobian matrices of the 
linearized system in the neighborhood of those fixed points have all vanishing eigenvalues. 
In this case, a new procedure must be taken, so that at first this degenerescence is raised, 
and then the points are classified ||]. We will not approach the degenerate case here. 

From what has been seen above, the topology of orbits in the linear neighborhood of 
fixed points is the same for both the null-torques and non-null constant torques cases. 

By the introduction of constant external torques, their intensity can be adjusted so that 
the robot arm be held any desired configuration in equilibrium. The majority of those 
equilibrium points are unstable, though: any fluctuation on the initial conditions can take 
the system out of equilibrium. In the case of the saddle-center points, the choice of certain 
branches of the saddle can lead to stable equilibrium, even in the presence of fluctuations. 
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V. CONCLUSIONS AND FINAL REMARKS 



We have proposed that the planar manipulator with two links and two rotational joins, a 
system with two degrees of freedom, be described by the hamiltonian of a double pendulum 
subject to two external torques. In its phase space, four fixed points (stationary solutions) 
can be found; a pure center, a pure saddle, and two saddle-centers, which can be used as a 
clue to the structure of orbits in in all phase space. We have also observed that there are two 
similar invariant manifolds, each one of them associated to a saddle-center points. The phase 
portrait of the system upon those manifolds resembles that of a mathematical pendulum 
of arbitrary amplitude. Dynamics upon such manifolds is governed by a unidimensional 
autonomous system, thus being totally integrable. For any set of initial conditions placed 
on one such manifold, the orbits will be confined to that manifold. We should keep in mind, 
however, that those manifolds are embedded into a four-dimensional phase space, so that 
the system in general in non-integrable. 

An important result is that for constant external torques, the phase space topology in 
the linear neighborhood of the fixed points is the same as that of the null-torques case, if 
certain conditions involving the torques and parameters of the system are satisfied. With a 
proper choice of torque intensities, then, we may define any point in configuration space as 
a fixed point, without altering its nature, in relation to the null-torques case. In particular, 
the topology of orbits in the linear neighborhood of the saddle-center points is the same, as 
the existence of the corresponding invariant manifolds. 

A possible continuation of this work involves the analysis of the non-linear neighbor- 
hood of fixed points. Strong indications of chaotic behavior are expected, due to the non- 
integrability of the system. 
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